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Abstract  -  An  important  capability  for  Autonomous  Underwater 
Vehicles  (AUVs)  is  station  keeping.  Station  keeping  is  the  ability 
of  a  vehicle  to  maintain  position  and  orientation  with  regard  to  a 
reference  object.  In  shallow  water  this  mission  most  likely  will  be 
disrupted  by  the  large  wave  induced  hydrodynamic  forces  acting  on 
the  vehicle.  To  counter  this  problem,  knowledge  of  these  wave 
induced  disturbances  is  critical  to  allow  for  the  design  of  a  control 
system  that  will  enable  the  vehicle  to  accurately  navigate  and 
position  itself. 

The  ability  to  develop  a  so  called  "predictive"  control 
strategy  for  underwater  vehicles  is  limited  by  the  methods  available 
to  measure  and  predict  the  wave  induced  disturbances.  Surface 
vessels  may  employ  remote  sensors  such  as  acoustic  probes,  lasers 
or  short  wavelength  radar  to  determine  future  disturbances,  but  this 
remote  sensing  is  not  feasible  in  a  low  cost  underwater  vehicle. 
AUV  control  system  design  is  limited  to  the  use  of  on  board 
sensors  for  disturbance  prediction. 

In  this  paper,  we  present  the  design  of  a  Sliding  Mode 
Controller  (SMC)  that  employs  multisensor  data  fusion  for  wave 
disturbance  prediction/estimation.  Using  data  obtained  from  the 
vehicle's  Doppler,  Acoustic  Doppler  Velocimeter  (ADV)  and 
motion  package,  a  dynamic  filter  is  developed  that  will  fuse  the 
information  from  the  various  sensors  and  provide  the  controller 
with  an  estimate  of  the  wave  induced  disturbance,  thus  allowing  the 
vehicle  to  station  keep  in  both  heading  and  position  with  far  greater 
accuracy. 


I.  INTRODUCTION 

For  an  Autonomous  Underwater  Vehicle  to  operate 
with  a  high  degree  of  reliability,  disturbances  and  their 
effects  on  the  AUV  must  be  modeled  mathematically  with 
an  adequate  degree  of  accuracy.  The  main  source  of  the 
dynamic  disturbances  encountered  by  underwater  vehicles  in 
very  shallow  water  are  wave  and  current  induced.  These 
disturbance  forces  arise  from  buoyant  and  inertial  effects 
due  to  ocean  wave  kinematics. 

In  this  paper,  we  will  show  how  the  bulk 
directionality  of  the  seaway  may  be  estimated  using  on 
board  sensors.  This  estimated  direction  provides  the 
necessary  heading  command  to  allow  the  vehicle  to  maintain 
an  optimal  orientation  to  an  object  to  which  the  vehicle  is 


positioning.  Second,  a  sliding  mode  controller  is  cast  which 
embodies  the  wave  disturbances.  A  Kalman  Filter  is  used  to 
fuse  sensor  measurements,  and  provide  an  estimate  of  the 
wave  states  based  on  measurements  obtained  from  the 
sensor  suite.  The  controller  will  use  the  fluid  velocity 
estimates  to  cancel  the  wave  induced  disturbances  thereby 
improving  the  vehicle's  ability  to  maintain  position. 

Finally,  through  simulation,  we  apply  the 
developed  filter  and  controller  to  the  NPS  "PHOENIX" 
AUV  and  demonstrate  its  ability  to  hold  position  while 
subjected  to  actual  shallow  water  waves. 

II.  SEAWAY  DIRECTION  ESTIMATION 


The  cross-spectra  of  a  tri-directional  current  meter 
yield  low  resolution  directional  wave  information  equivalent 
to  that  obtained  from  measurements  of  commonly  used 
surface-following  heave-pitch-roll  buoys  [1,  2,  3].  The 
normalized  co-spectra  of  the  vertical  (z)  velocity 
component  w,  and  the  horizontal  (x,  y)  velocity 
components  u  and  v  yield  the  lowest  four  Fourier  moments 
of  the  directional  distribution  (spreading  function)  of  wave 
energy  S  (0 )  =  E  (/  ,0 )  /  E  (f  ) ,  given  by. 
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where  C(f)  is  the  spectral  matrix  of  the  velocity  components 
it,  v;,  w.  Since  the  direction,  0  ,  is  referenced  to  the 
navigation  frame  (N-E-D),  vehicle  borne  sensor 
measurements  must  be  transformed  prior  to  use.  It  is 
interesting  to  note  that  the  estimates  of  these  directional 
moments  are  insensitive  to  errors,  so  long  as  the  errors  are 
the  same  on  all  measurement  axes  of  the  sensors,  which  is 
typical  with  oceanographic  sensors  installed  on  AUVs. 


0-7803-5045-6/98/$10.00  ©  1998  IEEE 


Report  Documentation  Page 


Form  Approved 
OMB  No.  0704-0188 


Public  reporting  burden  for  the  collection  of  information  is  estimated  to  average  1  hour  per  response,  including  the  time  for  reviewing  instructions,  searching  existing  data  sources,  gathering  and 
maintaining  the  data  needed,  and  completing  and  reviewing  the  collection  of  information.  Send  comments  regarding  this  burden  estimate  or  any  other  aspect  of  this  collection  of  information, 
including  suggestions  for  reducing  this  burden,  to  Washington  Headquarters  Services,  Directorate  for  Information  Operations  and  Reports,  1215  Jefferson  Davis  Highway,  Suite  1204,  Arlington 
VA  22202-4302.  Respondents  should  be  aware  that  notwithstanding  any  other  provision  of  law,  no  person  shall  be  subject  to  a  penalty  for  failing  to  comply  with  a  collection  of  information  if  it 
does  not  display  a  currently  valid  OMB  control  number. 


1.  REPORT  DATE 

2005 


2.  REPORT  TYPE 


3.  DATES  COVERED 


4.  TITLE  AND  SUBTITLE 

SHALLOW  WATER  STATION  KEEPING  OF  AUVS  USING 
MULTI-SENSOR  FUSION  FOR  WAVE  DISTURBANCE 
PREDICTION  AND  COMPENSATION 


5a.  CONTRACT  NUMBER 


5b.  GRANT  NUMBER 


5c.  PROGRAM  ELEMENT  NUMBER 


6.  AUTHOR(S) 


7.  PERFORMING  ORGANIZATION  NAME(S)  AND  ADDRESS(ES) 

Naval  Postgraduate  School, Center  for  AUV 
Research, Monterey, CA, 93943-5000 

9.  SPONSORING/MONITORING  AGENCY  NAME(S)  AND  ADDRESS(ES) 


5d.  PROIECT  NUMBER 

5e.  TASK  NUMBER 

5f.  WORK  UNIT  NUMBER 

8.  PERFORMING  ORGANIZATION 
REPORT  NUMBER 


10.  SPONSOR/MONITOR'S  ACRONYM(S) 

11.  SPONSOR/MONITOR'S  REPORT 
NUMBER(S) 


12.  DISTRIBUTION/AVAILABILITY  STATEMENT 

Approved  for  public  release;  distribution  unlimited 

13.  SUPPLEMENTARY  NOTES 

14.  ABSTRACT 

An  important  capability  for  Autonomous  Underwater  Vehicles  (AUVs)  is  station  keeping.  Station  keeping 
is  the  ability  of  a  vehicle  to  maintain  position  and  orientation  with  regard  to  a  reference  object.  In  shallow 
water  this  mission  most  likely  will  be  disrupted  by  the  large  wave  induced  hydrodynamic  forces  acting  on 
the  vehicle.  To  counter  this  problem,  knowledge  of  these  wave  induced  disturbances  is  critical  to  allow  for 
the  design  of  a  control  system  that  will  enable  the  vehicle  to  accurately  navigate  and  position  itself.  The 
ability  to  develop  a  so  called  "predictive"  control  strategy  for  underwater  vehicles  is  limited  by  the 
methods  available  to  measure  and  predict  the  wave  induced  disturbances.  Surface  vessels  may  employ 
remote  sensors  such  as  acoustic  probes,  lasers  or  short  wavelength  radar  to  determine  future  disturbances, 
but  this  remote  sensing  is  not  feasible  in  a  low  cost  underwater  vehicle.  AUV  control  system  design  is 
limited  to  the  use  of  on  board  sensors  for  disturbance  prediction.  In  this  paper,  we  present  the  design  of  a 
Sliding  Mode  Controller  (SMC)  that  employs  multisensor  data  fusion  for  wave  disturbance 
prediction/estimation.  Using  data  obtained  from  the  vehicle’s  Doppler,  Acoustic  Doppler  Velocimeter 
(ADV)  and  motion  package,  a  dynamic  filter  is  developed  that  will  fuse  the  information  from  the  various 
sensors  and  provide  the  controller  with  an  estimate  of  the  wave  induced  disturbance,  thus  allowing  the 
vehicle  to  station  keep  in  both  heading  and  position  with  far  greater  accuracy. 


15.  SUBIECT  TERMS 


16.  SECURITY  CLASSIFICATION  OF: 


a.  REPORT 

unclassified 


b.  ABSTRACT 

unclassified 


c.  THIS  PAGE 

unclassified 


17.  LIMITATION  OF 

18.  NUMBER 

ABSTRACT 

OF  PAGES 

5 

19a.  NAME  OF 
RESPONSIBLE  PERSON 


For  narrow  S  (0 ) ,  a  mean  propagation  direction 
0m  and  a  root-mean-square  measure  of  the  directional 
spreading  energy  G0  can  be  defined  in  terms  of  the 
first-order  and  second-order  Fourier  moments  a, ,  bt  ,  a2 
and  b2  [4]: 
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Og  =  —  [l  —  [a2  cos  (20 m  )  +  b2  sin (20 m  )]].  (8) 

The  resulting  directions  and  variances,  from  (5)-(8), 
are  for  each  frequency  component  of  the  wave.  To  use  this 
information  as  a  heading  command,  a  single  bulk  fluid 
direction  must  be  found.  Bulk  Fourier  moments,  weighted 
by  the  energy  density  of  the  wave  field. 
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with  E  the  swell  variance 


=  $E(f)df  , 


(10) 


may  be  substituted  into  (5)-(8)  to  yield  a  bulk  fluid  direction 
and  variance.  It  is  this  bulk  fluid  direction  that  is  used  as  the 
heading  command. 


III.  VEHICLE  SURGE  MODEL 


Much  of  the  research  in  the  past  has  dealt  with  deep 
water  use  of  AUVs.  In  this  environment,  the  influence  of 
wave  induced  forces  is  minimal  as  long  as  the  vehicle  is  not 
operating  too  close  to  the  surface.  In  a  shallow  water 
environment,  the  ability  of  a  vehicle  to  escape  these  wave 
induced  forces  is  impossible  since  these  forces  exist 
throughout  the  water  column.  Therefore,  to  properly  design 
a  surge  controller  it  is  necessary  to  begin  with  as  accurate  a 
model  of  the  vehicle  surge  dynamics  as  possible. 

The  equations  of  motion  (EOM)  based  on  constant 
hydrodynamic  coefficients  for  an  underwater  vehicle  are 
well  known  and  documented  in  the  literature,  reference  [5] 
being  just  one  example.  In  general,  the  hydrodynamic  forces 
on  a  submerged  vehicle  depend  on  the  relative  velocity  and 
acceleration  between  the  water  particles  and  the  vehicle.  The 
general  case  of  longitudinal  (surge)  motion  in  the  w-direction 
written  in  compact  form  is  given  by, 

(m  +  X  B-  )u  r  +  X  m  u  r  |m  r  |  =  F  prop  (t )  ,  (1 1) 


where 


ur  ={ug  ~U  fluid  ),  (12) 

and  Fprop(t)  represents  the  propulsion  force.  The  propulsion 
force  can  be  modeled  as 
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where  x  and  p  represent  a  time  constant  and  a  thrust 
parameter,  respectively.  Combining  (11)  and  (13)  and 
adding  the  kinematic  relation  for  a  vehicle  constrained  to 
longitudinal  or  surge  motion,  the  following  system  of 
equations  is  developed. 


X  =  ur  +U  f 

u  =0 iu  \u  I  +  F  ,  (14) 
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X  X 

where  the  steady  state  current  and  oscillatory  velocity 
caused  by  waves  are  added  directly  to  the  kinematic 
equation  since  relative  velocities  are  used  in  (11).  It  should 
be  pointed  out,  that  in  the  form  used  in  (14),  F  is  a 
generalized  force  with  units  the  same  as  an  acceleration. 

With  the  three  state  surge  model  (14)  developed,  an 
accurate  determination  of  the  parameters  a,  p,  and  x  is 
needed.  As  Marco  [6]  has  pointed  out,  using  system 
identification,  it  is  possible  to  obtain  these  values.  Since  the 
time  of  Marco's  experiments  in  [6],  the  PHOENIX  AUV  has 
had  its  propulsion  system  upgraded,  to  include  brushless  DC 
motors  for  propulsion,  increased  diameter/pitch  propellers 
and  ducted  shrouds.  From  at-sea  trials,  the  vehicle,  as  a 
result  of  these  system  upgrades,  is  now  capable  of 
approximately  3.5-knots  (~1.8  m/s)  at  525  revolutions  per 
minute.  Based  on  these  upgrades,  the  values  for  a,  p,  and  x 
are 

a  =  -4.036  m-i 

p  =1.034  m/rev2,  (15) 

X  =  1.15s 

which  will  be  used  throughout  the  remaining  design  and 
simulation. 


IV.  CONTROLLER  DESIGN 


Beginning  with  (14),  a  sliding  mode  controller  was 
formulated  using  standard  SMC  techniques.  The  sliding 
surface  G  was  defined  as  a  function  of  the  position  error. 


G  = 


—  +X 

dt 


(x  -X  ), 
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and  the  time  derivative  of  o  was  defined  as 


G  =  -r|M7f  (O  /(]) )  , 


(16) 
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with  T| ,  X  and  <j>  controller  tuning  parameters.  Taking  the 
time  derivative  of  (16)  and  equating  it  to  (17),  the  control 
input  may  be  determined. 
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Using  the  signed  square  root  of  (18),  the  commanded  control 
input  is  found.  A  detailed  description  of  this  controller 
design  approach  may  be  found  in  [7].  In  (18),  u,  represents 
relative  velocity  expressed  in  the  vehicle  frame,  and  Uf 
represents  fluid  velocity  expressed  in  the  vehicle  navigation 
frame. 


To  display  how  well  this  controller  is  capable  of 
performing,  consider  the  simple  case  of  a  monochromatic 
sine  wave  disturbance.  When  knowledge  of  the  wave 
disturbance  is  embedded  in  the  control  system  design, 
perfect  cancellation  of  the  wave  disturbance  effects  on 
station  keeping  may  be  obtained.  The  simulated  response  of 
the  PHOENIX,  initially  at  five  meters  and  closing  to  a 
commanded  range  of  0.5  meters,  is  displayed  in  Fig.  (1).  The 
results  in  Fig.  1  are  for  demonstration  purposes  only,  and  we 
do  not  expect  to  get  perfect  cancellation  of  the  wave 
disturbances  since  exact  measurement  of  each  wave 


Fig.  1  Example  Disturbance  Cancellation,  top  to  bottom  respectively, 
position  vs.  time,  propeller  RPM  vs.  time,  and  a  phase  plane  plot  of  the 
sliding  surface 


V.  FUSION  FILTER 


As  indicated  in  (18)  and  demonstrated  by  the 
simulation  of  the  previous  section,  the  controller  requires 
knowledge  of  the  fluid  velocity  and  its  first  and  second 
derivatives,  expressed  in  the  vehicle  navigation  frame,  to 
cancel  the  wave  induced  disturbances.  Since  these  quantities 
are  not  all  measurable,  they  must  be  some  how  obtained 
from  the  sensor  measurements  which  are  available  from  the 
AUV.  To  estimate  these  values,  a  Kalman  based  fusion 
filter,  driven  by  velocity  measurements,  was  developed. 


Prior  to  use  in  the  estimation  filter,  the  sensor 
measurements  must  be  processed  through  a  fusion 
transformation  matrix  (FTM).  This  matrix  will  fuse  ground 
speed  from  the  Doppler,  relative  water  speed  from  the  ADV, 
and  vehicle  attitude  (pitch,  heading  and  roll  orientation) 
from  the  motion  package,  to  produce  the  fluid  velocity, 
expressed  in  the  navigation  frame,  necessary  to  drive  the 
estimation  filter.  The  fusion  transformation  matrix  has  the 
form 

ftm  (4»,e,\|/)  =  [r  _1(<m,\|/),  -t  _1(<>,e,\|/)] ,  (19) 


where  T  '((]),0,\|/)e  91 3x3  is  the  inverse  Euler 
transformation  [8].  The  resulting  measurement 
transformation  has  the  form 
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where  the  first  three  measurements,  u  ,  v  ,  w  ,  are 

obtained  from  the  Doppler,  and  the  second  three 
measurements  are  obtained  from  the  ADV. 

The  estimation  filter  was  designed  assuming  that 
the  signal  could  be  represented  by  a  fifth-order  dynamic 


system,  three  states  used  for  U  f  ,U  f  ,U  ,  ,  and  second-order 


wave  dynamics,  of  the  form 

x  —  Ax  +  BD 


y  =Cx 


(21) 


The  A,  B  and  C  matrices  have  the  form 
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and  the  input  o  is  white  noise.  The  parameter  to  is  the 
fundamental  frequency  of  the  wave  field  found  by  the 
frequency  methods  used  during  the  directionality  estimation 
outline  in  Section  II. 

Using  this  dynamic  system  and  appropriate  values 
of  Q  and  R  to  properly  weight  the  model  uncertainty  and 
system  noise,  a  filter  was  developed  that  will  estimate  the 
required  values,  necessary  for  the  controller  [9],  To 
determine  the  accuracy  of  the  filter,  realistic  sensor  records 
containing  noise  and  measurement  uncertainty  were 
generated.  These  records  were  used  to  tune  the  filter  gains, 
and  determine  the  accuracy  of  the  filter  estimates.  Fig.  (2) 
shows  this  in  detail..  As  can  be  seen,  the  fifth-order  filter 
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provides  acceptable  tracking  and  smoothing  of  the  required 
signals  needed  in  the  controller. 


Fig.  2  Fusion  Filter  Results,  top  to  bottom  ,  surge  velocity,  first  and 
second  derivatives,  respectively  (dashed  lines),  and  the  filter  estimates 
(solid  lines)  vs.  time 

VI.  RESULTS 

Prior  to  implementation  of  the  fusion  filter,  we 
conducted  several  simulations  to  determine  the  performance 
that  could  be  obtained  from  the  controller  with  and  without 
all  disturbance  components  available.  The  disturbance 
components  in  these  simulations  were  assumed  to  be 
measurable  and  included  noise.  The  results  of  this 
comparison  are  shown  in  Fig.  3. 


Fig.  3  Controller  Performance  Comparison,  for  a  controller  that  uses 
all  the  disturbance  components  (dashed  line),  and  a  controller  that  uses 
only  fluid  velocity  for  disturbance  cancellation  (solid  line). 


As  can  be  seen  in  Fig.  3,  the  stationkeeping 
improvements  associated  with  including  all  components  as 
opposed  to  including  only  the  fluid  velocity  component  is 


very  small.  In  each  case,  the  propulsion  system  response  was 
within  the  vehicle's  capability,  but  was  extremely  oscillatory 
at  a  high  frequency  due  to  the  sensor  noise. 

As  a  result  of  the  comparisons,  it  was  determined 
that  by  using  only  the  fluid  velocity  measurements, 
significant  improvement  with  regard  to  positioning  may  be 
achieved,  but  that  the  fusion  filter  was  needed  to  filter  the 
noise  and  improve  the  high  frequency  response  of  the 
propulsion  system. 

The  final  simulations  involved  implementing  the 
combined  fusion  filter/controller  subject  to  real  wave  data. 
The  data  used  in  the  simulation  was  obtained  in  Monterey 
Bay,  CA  on  April  9th  1998.  The  Bay  was  classified  as  a  force 
3  on  the  Beaufort  Scale,  with  a  significant  wave  height  of 
approximately  0.6-meters.  A  portion  of  a  surface  elevation 
record,  obtained  from  a  Datawell  Directional  Waverider 
buoy,  and  a  portion  of  the  surge  velocity  record,  obtained 
from  a  velocity  array  taken  at  a  depth  of  20  feet  (6.1  meters) 
in  45  feet  (13.7  meters)  of  water,  is  shown  in  Fig.  4.  As  seen 
in  the  velocity  plot,  there  is  a  steady  current  of 
approximately  0.2  m/s  (0.4  kts).  This  current  is  caused  by 
the  bottom  topography  associated  with  Monterey  Bay. 


Fig.  4  Sample  Wave  Elevation  and  Fluid  Velocity  Record,  upper  plot 
wave  elevation,  lower  plot  fluid  velocity 


The  combined  filter/controller  results,  using  the  real 
wave  data  described  above,  are  shown  in  Fig.  5.  The  initial 
conditions  and  commanded  position  are  identical  to  the 
values  used  in  the  example  disturbance  cancellation 
simulation  of  Fig.  1 . 

As  can  be  seen,  the  vehicle  response  using 
disturbance  compensation,  is  maintained  around  the 
commanded  value  of  0.5  meters,  with  a  standard  deviation  of 
8.5  cm,  and  the  propeller  response  is  within  propulsion 
system  capabilities,  without  too  much  oscillation.  The  small 
offset  from  the  commanded  position  is  due  to  the  influence 
of  the  boundary  layer,  used  to  reduce  controller  chattering, 
in  the  sliding  mode  design. 
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The  vehicle  response,  without  disturbance 
compensation,  has  a  0.5  meter  steady  state  offset  with  a 
standard  deviation  of  17.7  cm,  which  is  twice  that  of  the 
controller  that  used  disturbance  compensation. 


Fig.  5  Vehicle  Response  Comparison  With  and  Without  Disturbance 
Compensation,  upper  plot  vehicle  position  with  (solid  line)  and  without 
(dashed  line)  disturbance  compensation  ,  and  lower  plot  propeller  RPM 
with  (solid  line)  and  without  (dashed  line)  disturbance. 


VII.  CONCLUSIONS 

The  results  presented  in  this  paper  demonstrate  that 
using  vehicle  borne  sensors,  the  mean  direction  of  the 
seaway  may  be  determined  and  used  as  an  input  to  the 
mission  controller  for  heading  corrections.  We  have  shown, 
through  simulation,  that  a  Kalman  based,  fusion  filter 
coupled  with  a  disturbance  embodied  sliding  mode 
controller  provides  an  AUV  the  ability  to  operate  in  the 
highly  energetic  shallow  water  environment  and  accurately 
stationkeep. 

There  are  several  open  issues  in  need  of  further 
research  and  analysis.  First,  with  recent  improvements  to  the 
longitudinal  surge  model  involving  a  thrust  reduction  term 
yHr|«|,  [6]  and  [10],  the  question  must  be  answered  as  to 

how  best  to  incorporate  this  term  in  the  sliding  mode  control 
design.  The  ability  to  properly  model  and  incorporate  this 
term  will  increase  the  accuracy  to  which  a  vehicle  can 
maintain  position. 

Second,  further  analysis  must  be  accomplished  on 
the  sensor  noise  and  uncertainty  problem.  With  sensors 
operating  at  different  sampling  rates,  and  with  different 
noise  and  uncertainty  characteristics  the  issues  involved  with 
latency  of  data,  and  the  stability  issues  associated  with 
varying  signal-to-noise  ratios  must  be  investigated. 

Lastly,  implementation  of  the  filter/controller  into 
the  NPS  PHOENIX  AUV  must  be  accomplished  to  test  the 
ability  of  the  controller  to  perform  in  the  operational 
environment  subject  to  the  real  world  uncertainties. 
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